# -*- coding: utf-8 -*-
"""
Created on Mon Jul 31 18:29:21 2017

@author: decardin
"""

from casadi import *
import numpy as np

class Controller:
    
#def nmpc(f=None, g=None, l=None, Pf=None, )

def colloc():
    